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Midcourse  guidance  is  commonly  designed  to  save  as  much  energy  as  possible  so  that  the  missile’s  final 
speed  can  be  maximized  while  entering  the  homing  stage.  For  this  purpose,  a  competitive  guidance  design 
should  be  able  to  generate  an  admissible  flight  trajectory  as  to  bring  the  interceptor  to  a  superior  altitude 
for  a  favorable  target  engagement.  In  this  paper,  a  new  adaptive  trajectory  shaping  guidance  scheme  based 
on  the  adaptive  fuzzy  inference  system,  which  is  capable  of  generating  a  variety  of  trajectories  for  efficient 
target  interception,  is  presented.  The  guidance  law  is  developed  with  the  aim  of  saving  the  interceptor’s 
energy  conservation  while  improving  performance  robustness.  Applications  of  the  presented  approach 
have  included  a  variety  of  mission  oriented  guidance,  such  as  cruise  missile  guidance,  anti-ballistic  missile 
guidance,  etc. 

©  2008  ISA.  Published  by  Elsevier  Ltd.  All  rights  reserved. 


1.  Introduction 

A  multitude  of  guidance  design  techniques,  such  as  linear 
quadratic  regulator  (LQR)  [1]  modified  proportional  guidance  [2] 
and  geometric  control  [3]  have  been  proposed  in  the  literature  for 
implementation  of  the  optimal  midcourse  or  terminal  guidance 
laws.  In  particular,  LQR  and  neural  networks  have  recently  been 
applied  to  deal  with  the  anti-ballistic  missile  guidance  design 
problem  [4].  Traditionally,  midcourse  guidance  was  formulated 
mostly  as  an  optimal  control  problem  to  shape  the  flight  trajectory 
and  to  maximize  the  terminal  speed  or  minimize  the  flight  time. 
However,  solving  LQR  problems  or  training  neural  networks  in 
real-time  is  often  practically  infeasible.  Neural  network  guidance 
might  be  unreliable  in  practice  if  the  neural  network  was  not 
well  trained.  It  is  very  common  that  neural  network  sensibly 
interpolates  input  data  that  are  new  to  the  network,  causing 
unpredictable  outputs.  Fuzzy  logic  conceptually  possesses  the 
quality  of  robustness.  It  is  well  known  that  fuzzy  systems  have 
the  ability  to  make  use  of  knowledge  in  expressing  in  the  form  of 
linguistic  rules  without  resorting  to  the  precise  model.  However, 
its  early  application  relied  on  trial  and  error  while  selecting  either 
the  membership  functions  or  the  fuzzy  rules.  An  adaptive  fuzzy 
logic  controller  working  as  an  adaptive  neural-fuzzy  inference 
system  (ANFIS)  relieves  this  stringent  requirement  [5].  Some 
researchers  also  attempted  to  apply  fuzzy  logic  theory  to  missile 
guidance  designs  [6-9]. 

Literature  detailing  the  issues  of  modern  guidance  law  design 
subjects  to  multi-boundary  conditions  is  quite  rare.  A  spline  missile 
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guidance  law  possesses  a  generalized  interpolating  structure  that 
artificially  allows  reshaping  the  flight  trajectory  with  respect  to 
the  specified  via  points  and  two  boundary  conditions.  Although 
increasing  attention  has  been  devoted  to  the  applications  of  fuzzy 
logic  on  missile  guidance  and  control,  the  fuzzy  spline  guidance 
design  has  rarely  been  attempted.  Here,  the  interceptor’s  flight 
trajectory  is  reshaped  by  combining  ANFIS  with  spline  guidance 
to  navigate  the  missile’s  flight  through  the  specified  midpoints 
for  lower  control  energy  consumption  and  a  favorable  target 
engagement.  Based  on  the  adaptation  feature,  the  guidance  law 
is  shown  as  to  achieve  better  performance  robustness  than  the 
guidance  law,  simply  with  constant  navigation  gains. 

2.  Generalized  trajectory  shaping  guidance 

Suppose  that  the  inertial  frame  is  located  at  the  ground  tracker. 
The  present  position,  velocity,  and  midpoints  of  the  interceptor  are 
defined  as 

r(t0)  =  (xo,yo,z0),  v(t0)  =  (x0,y0,z0), 

rA(tA)  =  (xA,  yA,  zA),  rB(tB )  =  (xB,  yB,  zB) 

where  x  is  the  downrange, y,  the  cross  range,  and  z,  the  altitude;  the 
subscripts  0,  A,  and  B  of  t  represent,  respectively,  the  initial  time, 
the  time  at  midpoint  A  and  the  time  at  midpoint  B.  The  acceleration 
command  vector  is  to  be  determined: 

ac(t )  =  [ax(t),  ay(t),  az(t)],  t0  <  t  <  tf 

where  tf  is  the  final  flight  time.  Equations  of  motion  of  the 
interceptor  in  Cartesian  coordinates  are 


x  =  vx. 

II 

p 

y  =  Vy, 

II 

(1) 

z  =  vz, 

Vz  =  az  +g 
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where  g  is  the  gravity  acceleration.  For  the  target,  let 


*t  —  —  V&i  vtx  —  Gfx> 

Yt  —  ~vty s 

2*  =  —  Utz,  Vtz  =  Qtz  +  g 


(2) 


where  afx,  afy  and  atz  are  disturbance  inputs. 

Define  the  relative  range  between  the  interceptor  and  the  target 
as 


R  : 


mtx  ^ mty  “1“ 


>2 

mtz 


where Rmtx  =  xt  —x, Rmty  =  yt  —  y,  and Rmth  =  zt—z. The  midpoints 
rA(tA )  and  rB(tB )  are  pre-specified,  and  the  predicted  interception 
point  are  given  by 


Xf  —  "T  oxTg0, 


y/ 


z  yo  VyTgo, 


Zf  =  Zo  + 


go 


where  (xf,yf,zf)  =  (x(tf),  y(tf),  z(tf))  and  Tg0  «  i?/uc  with 
uc  denoting  the  closing  velocity  between  the  interceptor  and  the 
target. 

In  previous  research,  the  proportional  navigation  guidance  law 
has  been  shown  to  be  a  special  case  of  the  explicit  guidance 
law  [10],  while  explicit  guidance  is  a  special  case  of  spline  guidance. 
The  spline  guidance  law  will  be  abbreviated  as  S-N  guidance 
law  according  to  the  number  of  via  points,  which  includes  two 
boundary  conditions  and  N-2  midpoints. 

S-N  guidance  law  considers  the  diagonal  linear  system  of  the 
form  [11,12]: 

2A  u 

At|  2(Ati  -\~  At2)  At| 


Atn_2  2(Atn_2  +  Atn_i)  Atn_i 
Atn_i  2A  tn_i_ 


Xo 

Ax\/ At\  -x0 

X\ 

=  6 

Ax2/A  t2  —  Ax\/  At\ 

Xn-2 

Axn_i/Atn_i  -  Axn_2/Atn_2 

-  %  _ 

xf  -  Axn_i/Atn_! 

where  Xf  =  xN.  The  acceleration  command  can  be  rewritten  as 

xc(t)  =  Xfc-1  Pi(t)+xkP2(t),  tk-i  <  t  <  tk,  k  =  1,  2, . . . ,  N  -  1 

where  Pi(t)  and  P2(t),  the  pre-specified  functions  of  time,  are 
linearly  independent. 

To  simplify  implementation,  the  following  functions  are  chosen 


PiCt)  =  l. 

That  is 

Xc(t)  =Xk_i, 


p2(0  =  o. 


k=  1,2,  ...,N-  1. 


One  should  be  particularly  interested  in  N  =  4.  For  that  case, 
the  guidance  law  can  be  viewed  as  the  generalization  of  S-4,  S-3, 
and  S-2  guidance  laws.  Fig.  1  shows  three  guidance  phases  of  S-4 
guidance  law.  During  the  first  phase,  the  interceptor  is  guided  by 
S-4  guidance  law,  the  interceptor  in  the  second  phase  is  guided  by 
S-3  guidance  law,  and  the  interceptor  in  the  last  phase  is  guided  by 
S-2  guidance  law.  On  the  basis  of  this  arrangement,  it  is  possible 
to  construct  a  variety  of  favorable  flight  trajectories  to  effectively 
intercept  targets  from  various  incoming  directions.  For  example, 
one  may  set  xA  <  xB  <  Xf  to  reach  a  near  head-on  interception  for 
ballistic  targets.  By  setting  xA  >  xB  ~  X/,  the  interceptor  could  act 
to  engage  cruise  targets.  Fig.  2  displays  three  representative  flight 
trajectories. 


S(t) 


*(m) 


Fig.  2.  Various  trajectories  generated  by  the  S-4  guidance  law. 

2.1.  Derivation  of  S-4  guidance  law 

Let  the  S-4  trajectory  be  denoted  as  S(t),  which  passes  through 
x0,  Xf,  and  two  midpoints  Xi ,  x2.  Define  a  three-order  polynomial  /k 
as  follows 

fk(t)  =  —  ffe-l)3  +  Bk(t  —  ffc-l)2  +  Ck(t  —  tk- 1)  +  Dk > 

k=  1,2,3  (3) 

where  Ak,  Bk,  Ck  and  Dk,  k  =  1,2,3,  are  coefficients  to  be 

determined.  S(t)  has  to  satisfy  two  boundary  conditions  with 
velocity  and  the  positions  of  two  midpoints. 

The  conditions  for  the  continuity  of  the  splines  at  the  knots  are 
given  by 


(i) 


xk~i  =fk(tk- 1)  =  Dk, 

Xk  =  fk(tk)  =  AkAt^  +  BkAtl  +  CkAtk  +  Dk 


(ii) 


xk~\  =fk(tj{- 1)  =  Ck, 

Xk  —  fk  (fk)  =  3AkAtl  +  2  BkAtk  +  Ck 

(hi) 

xk— i  =  fk  (tk—  i )  —  2  Bk , 

Xk  =  fk(tk)  =  6AkAtk  +  2  Bk 

where  A tk  =  tk  —  tk- From  (4)  and  (6),  one  gets 


(4) 


(5) 


(6) 


Ak  = 


1 


6At/< 


(Xk  ~  Xk- 1), 


1.. 

Bk  =  ~xk—\, 


Axk  A  tk  .. 

Q  =  — - —  (xk  +  2xk_i), 

A  tk  6 

where  Axk  =  xk  —  xk-\. 


(7) 


Dk  =  xk—i 
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Substituting  (7)  into  (5),  one  further  obtains 

k  =  1,2,3 


Axk  1 

Xk- 1  =  —  -  -  A tk(xk  +  2x/(_1), 
A  tk  6 


and 

Axt  1 

Xk  =  —  +  -  Atk(2xfc  +  2xk_i). 
A  tk  6 


(8) 


(9) 


Differentiation  of  S(t)  should  be  continuous  at  the  knots,  i.e. 

A-i(t*-i)=A(t*-i),  k  =  2,3.  (10) 

By  substituting  (5)  into  (10),  one  obtains  the  following  recursive 
equations: 


3Afc— i  Atfc_i  +  2B/C_i  At/C_i  +  Cfc—i  —  C/c,  k  —  2,  3. 
Substituting  (7)  into  (10),  gives 
Atk-{xk-2  +  2(Atk-i  +  A  tk)xk-i  +  A  tkXk 

/  A Xk  _  AXfc,]  \ 

\  A  tk  Atfc_,  /  : 


k  =  2,  3. 


(11) 


(12) 


There  are  two  equations  and  four  unknown  acceleration  terms. 
Therefore,  two  extra  conditions  should  be  available.  From  (8)  and 
(9),  one  has 


where  X  =  f|  +  +  +  +•  Clearly,  when  At,  %  A t2 
can  be  simplified  as 

2 

Xo=5 


At3,  it 


(Xf  -  Xq)  6(Ax2/A t2  ~  Axi/Ati) 


3(Ax3/A t3  -  Ax2/At2)  9(xi  -  Xp  -  x0TgoA ) 
+  ^  Tg20, 


(16) 


where  Ax2/At2  —  Axi/Ati  and  Ax3/At3  —  Ax2/A t2  are, 
respectively,  the  curvature  changes  of  phases  1  and  2;  x\  —  x0  — 
x0TgOyi  is  the  position  error  at  point  A. 

Phase  2:  (tA  <  t  <  tB) 

The  objective  is  to  shape  an  appropriate  flight  trajectory  so  that 
the  guidance  commands  generated  in  Phase  1  would  be  smoothly 
transferred  to  the  next  guidance  phase. 

The  acceleration  command  during  the  period  [tA,  tB]  is  given  by 


rjAt2 


(~rj2Ct\  +  2 r\20i2  ~  4a3  +  2a4). 


As  TgoA  ->  0,  the  interceptor  arrives  at  midpoint  A,  we  get 
limAtl^0  Axi/Ati  =  x0  and  ot\  ->  0,  then 


Xf  -  x0  3(Ax3/A t3  -  Ax2At3/At|) 


.  Axi 

2AtiX0  +  AtiXi  =  6 - x0 

Ax3 

A  t3x2  +  2A  t3x3  =  6  (  x3  -  — 
A  t3 


(13) 

(14) 


Eqs.  (12)— (14)  now  constitute  a  tri-diagonal  linear  system  of 
equations.  From  which  one  can  have  x2,  i  =  1, . . . ,  4,  determined 
by 


*0 

*1 

2 

*2 

rjAt2 

3_ 

-m 

2 

-1 


-rj2  2  -1 

2  m  -4  2 

-4  2y)3  -rj3 

2  -rj  3  2r]4_ 


ot  1 
a2 
a  3 

_0?4_ 


where  a\  =  Axi/Ati  —  x0,  a2  =  Ax2/At2  —  Axi/Ati,  a3  = 
Ax3/At3-Ax2/At2,a4  =  xf  —  Ax3/At3;  rj  =  4(1  +  Ati/At2)(l  + 
At3/At2)  -  (At\/ At2)(At3/ At2),  77!  =  3(1  +  Afe/A^Kl  + 
At3/ At2)  +  1,  ?72  =  3(1  +  At3/ At2)  + 1,  rj3  =  3(1  +  Ati/ At2)  + 1, 
774  =  3(1  +  At\/ At2)(l  +  At2/At3)  +  1;  Ati  =  -  t0,  Axi  = 

xi-x0,  At2  =  tB-tA,  Ax2  =  x2-Xi,  At3  =  Ax3  —  xf  x2 . 

For  briefness,  define  Tg0  =  Ati  +  At2  +  At3,  TgoB  =  Ati  +  At2 
and  TgoA  =  Ati.  S-4  guidance  law  is  determined  via  the  following 
equations: 


xc(t)  =  xk_i,  tfc_i  <  t  <  tk,  k  =  1,  2,  3. 


(15) 


Phase  1:  (t0  <  t  <  tA) 

The  primary  objective  of  this  phase  is  to  guide  the  interceptor 
to  an  appropriate  altitude  and  to  avoid  excessive  energy  loss  while 
achieving  a  higher  speed. 

The  guidance  command  during  this  phase  is  derived  as 


*0 


T]At2 


(2771a!  -  rj2a2  +  2a3  -  a 4) 


AT  I  Q  Af3 
^lSO  “I-  J  a  t2 


L  Axi  At3  Ax2  A t3  Axi 

6/ - 6/Xo  -  3 - h  3 - 

[  Ati  A t2  At2  At2  Ati 


Axi  Ax2  Ax3 

+  12 — -  —  6 — -  +  3 — -  —  8x0  —  Xf 
Ati  At2  At3 


+ 


6(X2  -  Xq  -XqA t2) 


(A  t2  +  At3)At2 
When  Ati  ~  At2  ~  At3,  Xi  reduces  to 
Xf  -  x0  3(Ax3/A t3  -  Ax2/A t2) 


Xi  = 


+ 


jgo  Jgo 

3(x2  -  Xq  -  XoTgofi) 

T2 

1  goB 


where  At2  =  TgoB  -  TgoA  and  L 


Jg0A 


(17) 


0  when  tA  <  t  <  tB.  When 


x0  =  xA,  S-4  guidance  reduces  to  S-3  guidance. 

Phase  3:  (tB  <  t  <  t/) 

Since  the  position  error  dominates  the  final  missile  distance, 
the  major  objective  during  this  phase  is  to  fully  develop  the 
missile’s  terminal  engagement  performance.  The  navigation  term 
contributed  by  the  position  error  should  contribute  to  effective 
acceleration  command  so  that  the  accumulated  tracking  errors  can 
be  significantly  reduced. 

The  acceleration  command  in  the  period  (tB,  tf]  is  given  by 


x2  = 


T]At2 


(2a  1  -  4a2  +  2r]3a3  -  r]3a4) . 


As  TgoB  ->  0,  the  interceptor  passes  through  point  B,  then 

limAt2^0  Ax2/A t2  =  x0,  ai  =  a2  ->  0,  A t3 


Tg0  and 


x2  = 


AT  I  Q  Afl 

41go  +  3  At2 


4  +  3^^X/  -7x0 


.  Ati 

~|15  +  6^ 


^  ^0  +  ^ 


A  t2  / 

,^1 

A  t2 


12 


Ax3 
A  t3 


It  can  be  seen  easily  that  as  Ati  0  and  A t2  ->  0,  i.e.  xA  is  close 
to  xBl  then  S-3  guidance  law  becomes  the  known  explicit  guidance 
law  [10]: 

—2 (Xf  -  x0)  6(X/  -  Xo  -  x0Tgo) 

X2  = - i - 1 — 


lgO 


T2 

Jgo 


(18) 
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Under  the  assumptions  of  Ati  ~  A t2  ~  A t3,  the  acceleration 
commands  in  the  inertial  frame  can  be  summarized  as  follows 


*o  = 


2 

5 


(*/  -  Xo) 
Tgo 


6(Ax2/A t2  -  Axi/Ati) 
Tg0 


(ii)  When  tA  <  t  <  tB, 


Rj  :  IF  /ci  is  AND  /c3  is  AJ3  AND  /c5  is  Aj5 , 
THEN  xc  =  4^1 +4^+4^ 

lgo  IgoB 


3(Ax3/A t3  -  Ax2/A t2)  9(xi  -  x0  -  x0TgO/i) 


JgO 


r2 

1  goA 


Xi 


to  <t  <tA 

(*/  -  Xo)  3(Ax3/Af3  -  Ax2/A t2) 


(19) 


Tg0  Ts 

3(x2  -  x0  -  XoTg0B) 

t2  ’ 

1  goB 


tA  <  t  <  tB 


— 2(x/  -  x0)  6(x/  -  x0  -  x0TgO) 

X2  = - = - 1 - ^ - .  tB  <  t  <  tf. 

lgO  JgO 

The  guidance  commands  for  the  Y-axis  can  be  obtained  analo¬ 
gously.  And,  the  guidance  commands  for  the  Z-axis  are 


2 

20  =  5 


(Zf  -  Zq)  6(Az2/At2  -  Azi/Ati) 


3(Az3/At3  -  Az2/At2)  9(Zi  -  z0  -  ZoW 

+  T  +  T2 

1 goA 


= 


to  <t  <tA 

(Zf  -  Zq)  3(Az3/At3  -  Az2/At2) 


z2  = 


.  3(z2  —  z0  —  z0TgoB) 

+  - 32 - —  +£,  tA<t<tB 

lgoB 

—  2(2/  -  Zo)  ,  6(z/  -  Zo  -  Z0Tgo) 


+ 


T2 

go 


+  g,  tB<t<tf. 


(20) 


It  should  be  noted  that,  after  some  transformations,  the  command 
switching  can  be  altered  to  the  relative  range  between  the 
interceptor  and  the  target. 

In  the  trajectory  shaping  guidance  scheme  developed  above, 
the  acceleration  command  with  constant  gains  are  adequate 
for  a  target  engagement  when  the  relative  range  between  the 
interceptor  and  the  target  is  relatively  short.  However,  it  is  highly 
desirable  to  further  improve  its  performance  robustness  since  the 
guidance  law  with  constant  gains  is  robust  enough  to  withstand 
environmental  changes  and  target  maneuvers.  This  gives  rise  to  the 
requirement  of  the  functionally  adaptive  feature. 


3.  Adaptive  S-4  guidance  law 


The  guidance  parameters  of  the  S-guidance  law  become 
dynamically  tunable  by  introducing  the  architecture  of  ANFIS. 
ANFIS  is  a  class  of  adaptive  networks  that  are  functionally 
equivalent  to  fuzzy  inference  systems.  ANFIS  represents  both  the 
Sugeno  and  Tsukamoto  fuzzy  models  and  use  a  hybrid  learning 
algorithm.  For  a  useful  tutorial  reference  one  is  referred  to  [13]. 
Based  on  its  structure,  one  can  construct  a  group  of  fuzzy 
rules,  specifying  the  guidance  commands  with  respect  to  three 
engagement  phases.  For  briefness,  only  the  guidance  rules  on  the 
X-axis  are  presented.  The  guidance  rules  for  the  Y  and  Z  axes  can 
be  derived  analogously. 

To  form  a  standard  ANFIS,  the  following  the  following  Sugeno 
and  Tsukamoto  fuzzy  models  are  first  established. 

(i)  When  t0  <  t  <  tA, 


Rj  :  IF  K\  is  A\  AND  /c2  is  AJ2  AND  /c3  is  A3  AND  k4  is  AJ4. 

THENxc  =  fe'^+fc'2^+fe'3^+fe'4-^ 


igO 


igO 


lg0 


T2 

1  go  A 


(iii)  When  tB  <  t  <  tfy 

Rj  :  IF  is  A\  AND  x6  is  a{  THEN  xc  =  —  +  fci, 

Tg0  Tg0 


where  k\  =  kf  —  x0  (velocity  error),  k2  =  ^  ^  (curve 

change  1),  /c3  =  (curve  change  2),  k4  =  x i  -  x0  -  x0TgoA 

(position  error  at  tA\  k5  =  x2  —  x0  —  x0TgoB  (position  error  at  tB ) 
and  k6  =  Xf  —  x0  —  x0Tgo  (position  error  at  tf)  with  Tgo  being  the 
time-to-go  with  respect  to  the  interception  point. 

Then,  to  facilitate  adaptation  of  the  gain  scheduling  model,  it 
is  convenient  to  put  the  fuzzy  model  into  the  framework  of  an 
adaptive  network.  In  the  following,  the  output  of  the  i-th  node  in 
the  fc-th  layer  is  denoted  by  0\. 

Layer  1 :  Each  node  represents  an  input  that  passes  an  external 
signal  to  the  next  layer. 

Phase  1:  O’  =  /iA,  (x,),  O’  =  ^  (x2),  O’  =  nAi  (x3), 

1  n2  2  ^3  3 

0\,  =  IJ-Ai  (x4),  i  =  1 

4 

Phase  2:  OV  =  (x,),  oV  =  ^ (x3),  0^  = 

^(k5),  i  =  1, . . . ,  m 

Phase  3:  O’  =  /xA,  (xi),  O’  =  /iAi  (x6),  i=1,...,m 

1  o  6 

where  m  is  the  number  of  fuzzy  sets  with  respect  to  the 
corresponding  term-set  of  /q,  the  membership  functions 
liAi  (•),  ii Ai  (•)»  Ii#  (*)  ^  i  (0  are  defined  as  follows 

1  2  3  aa  a  fi 


^A\  (^l)  =  eXP  - 


\iAk2)  =  exp  - 


fiAK-i)  =  exp 


IiAki)  =  exp 


xi  -  rrii 


k2  -  rrii 


k3  -  rrii 


ki  -  rrii 


CTi 


,  1  =  4,5,6. 


A  desired  membership  function  is  obtainable  by  ad¬ 
justing  the  parameter  triplet  (05,  bf,  rrii).  Fig-  3  illustrates 
the  initial  bell-shaped  membership  functions. 

Layer  2:  Each  node  performs  the  product  operation.  Any  t-norm 
operator  can  also  be  used  as  the  node  function  for  the 
generalized  AND  function. 

Phase  1:  J02  =  of  =  /xAi  (/ci)/xAi  (/c2)/x^(/c3)/x^(/c4), 

i  =  j=  1,  . . . ,  L  (=m4) 

Phase  2:  j02  =  cri  =  /x^(/ci)/x^(/c3)/x^(/C5), 

i  =  1  1, . . . ,  L(=m3) 

Phase  3:  J02  =  oof  =  /iAi  (tc\)iiAi  (/c6),  i  =  1 , ,m, 

j  =  1,  ...,L(=m2). 

Layer  3:  Each  node  calculates  the  normalized  firing  strength  of  a 
rule. 

Phase  1:  j03  =  A  =  Phase  2:  J03  =  a)  = 

Phase  3:  J03  =  oJ  = 

A  ixj 

Layer  4:  Each  node  calculates  the  weighted  consequent  value.  The 
consequent  parameters  kj  J  =  1, . . . ,  6  are  to  be  tuned. 
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curve  change  2  {ml  sec)  position  error  (m) 

Fig.  3.  Membership  functions  of  the  (a)  velocity  error  (k  i)  (N:  negative,  Z:  zero,  P:  positive);  (b)  curve  change  1  (/c2)  (S:  small,  M:  medium,  L:  large);  (c)  curve  change  2  (/c3); 
(d)  position  error  (a:4,5?6  )- 


Fig.  4.  Structure  of  the  ANFIS. 


Phase  1:  J04  =  ajfj  =  cti  +  1^2k2  +  /4^3  + 

Phase  2:  J04  =  &y/j-  =  oV (/<4 ati  +  /4k3  +  /4^s)» 

Phase  3:  J04  =  ocffi  =  ccf{l^K\  +  1^6k6). 

Layer  5:  Node  i  sums  up  all  incoming  signals  to  obtain  the  final 

inferred  result. 

Phase  1 :  xc  =  Ej  & fj >  phase  2:  xc  =  Ej  &fj> 

Phase  3:  xc  =  Ej  ^ fj • 

See  Fig.  4  for  the  structure  of  the  ANFIS.  After  an  adaptive 
network  which  is  functionally  equivalent  to  a  Sugeno  and 
Tsukamoto  fuzzy  model  has  been  constructed,  the  consequent 
parameters  are  regulated  by  a  learning  algorithm.  This  is  presented 
as  follows. 


Phase  3  :E3  =  \{w\k\  +  w2k |),  E/  wi  =  1 
where  wit  i  =  1—4,  are  suitable  weighting  factors  to  fit 

the  respective  mission  objective.  For  Phase  1,  the  conversion  of 
kinetic  energy  to  potential  energy  is  significantly  affected  by  the 
curvature  change  during  [t0,  t2\‘,  therefore,  it  is  heavily  weighted. 
Similarly,  for  Phase  2,  the  curvature  change  during  [t2,  t/]  and  the 
position  error  are  jointly  placed  with  larger  weightings  where  the 
importance  of  position  error  emanates.  For  Phase  3,  the  position 
error  is  more  important  than  the  velocity  error;  therefore,  set  w2  > 

W\. 

Adaptive  tuning  equations  for  k mj,  and  o\  are  summarized  as 
follows. 

Phase  1:  k j,  mj,  crj  (frj  =  1),  l  =  1  —  4,  j  =  1, . . . ,  L 

fc/(£  +  1)  =  k/(0  +  Akj(t) 
where 


=  rj 


dx0  a(x0/Ati)  d(Xf/At3) 

-W  1/Cl— r-  +  w2k2 - — - h  w3K3 - — - 

dxc  dxc  dxc 


W4K4- 


d(Xo  +  Xo  TgoA) 
dxc 


dxc 

afci 


with  77,  1  r]  >  0,  being  the  update  gain  and  <1 . 

3/c;  2-,j  Mj 


Similarly,  the  parameter  update  equations  for  mj  are  determined 
via 


3. 1.  Adaptive  guidance  parameter  update  law 

To  aim  at  minimizing  the  kinetic  energy  loss,  the  following 
performance  costs  are  defined: 

Phase  1  :  £1  =  \  Et=i  wiKh  E/  wi  =  1 

Phase  2  :  E2  =  +  w2k\  +  u;3/c|),  Ei  wi  —  1 


mj(t  +  1)  =  mj(t)  +  Amj(t) 
where 


=  rj 


dx0  a(x0/Ati)  a(x//At3) 

-1^1X1  —  +  w2/c2 - — - h  m3/c3 - — - 

9xc  9xc  dxc 
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Fig.  5.  (a)  Inertia  control  command,  (b)  missile  velocity,  (c)  engagement  trajectory. 


$(*0  XoTgoA)  1  9xc 
-  W4/C4 - TT7 -  - 7 

dxc  J  3mj 

with 

dxc  _  dXc  dy  d/ij  _  fij  dy  2 (x,  -  mj) 

dm j  dy  dnj  d/tj  amj  Em/  9/i0j  a/2 

1  i  1 

And 


mj(f  +  1)  =  m{(t)  +  3 


[- 


3xo  3^6 1  9xc 

u>i  xt— +  w2x6—  — 7 

3xc  dxc  J  3mj 


3x0 


crjit  +  1)  =  cr/(f)  +  j?  -W1X1—  +  w2x6 

L  dxc 


3  x6 


3Xr 


9xc  _  Qcrj 


The  lateral  acceleration  commands  obtained  above  have  to 
be  transformed  to  the  interceptor’s  body  frame  by  applying  the 
following  coordinate  transformation: 


o/(t  +  1)  =  o/(t)  +  Act/(C) 
where 

Act/  (t)  =  -rjV^E^t) 


3x0  3(x0/At1)  d(xf/At3) 

WlXl—  +  W2X2 - T77 - h  W3X3 - — - 

9XC  9XC  9XC 


W4K4  ~ 


3(x0  +  koTgoA)‘ 
dXr 


3xc 

dcrj 


with 

dXc  _  3XC  dy  d/ij  _  Hj  dy  2 (x,  -  ct/)2 

3 ct/  3y  diXjd/xj  3ct/  EVjdHj  i3 


Phase  2:  kj,  mj,  o/(bj  =  1),  l  =  1,  3,  5,j=1,...,L 
fc/(f  +  1)  =  — ??V)(/E2(t) 

=  fcj(t)  +  v  - 

9(xq  + 


3x0  d(xf/At3) 

7^  +  w2/c3 - rr; - 

3xc  3xc 


-  w3k5- 


+  x0rgog)  1  3Xc 

9*c  J  dk { 


m|(t  +  1)  =  m}(t)  +  r] 

9(xq  +  Xq  Tgos) 


dx0  d(xf/At3) 

W  i/Ci  —  +  w2/c3 - rrr - 

9xc  9xc 


w;3/c5- 


9xc 


3xc 

9m! 


or/(t  +  l)  =  a/(t)  + 17 


9x0  d(xf/At3) 

~W\K\  +  m2/c3 - — - 

3xc  3xc 


m3/c5- 


9(x0  +  x0rgog) 
3xc 


3xc 

dcrj 


Phase  3:  kj,  mj,  o/(fc{  =  1),  l  =  1,  6,j  =  1, . . . ,  L 
l^(t  +  1)  =  —  rjW^E3(t) 

=  K  (0  +  9 


3xo  3/C6 1  9xc 

—  +  w2k;6—  — 7 
3xc  3xcJ  akj 


^mp 


body 


=  M 


"*c" 

yc 

_2C. 


where  amy  and  amp  indicate,  respectively,  the  lateral  acceleration 
commands  on  the  horizontal  and  vertical  planes,  and  the 
coordinate  transformation  matrix  £  is  defined  as 


M  = 


sin  0  sin  y  cos  0  —  cos  0  sin  0 
cos  0  sin  y  cos  0  +  sin  0  sin  0 


sin  0  sin  y  sin  0  +  cos  0  cos  0 
cos  0  sin  y  sin  0  —  sin  0  cos  0 


sin  0  cos  y 
cos  0  cos  y 


where  0,  0,  y  are,  respectively,  the  roll  angle,  the  azimuth  angle, 
and  the  flight-path  angle. 


4.  Results  and  analyses 

First,  a  target  with  the  incoming  speed  of  212  m/s  and  flight 
path  angle  of  70.5  degrees  was  considered.  In  this  case,  the  initial 
target  position  was  (60000,  60000,  140000)  (m).  Fig.  5  shows 
the  control  history,  velocity,  and  engagement  trajectory  with  the 
interceptor  simply  guided  by  the  adaptive  S-2  guidance  law.  The 
total  flight  time  is  132.1  s.  Fig.  6  shows  the  results  for  the  same 
scenario,  along  with  the  interceptor  guided  by  S-2  guidance  law 
with  constant  gains.  The  total  flight  time  is  197  s,  which  is  much 
longer  than  the  previous  adaptive  case. 

For  the  second  scenario,  we  considered  the  initial  target 
position  at  (60000,  60000,  140000)  (m).  The  two  via  points  of 
interceptor’s  flight  trajectory  were  set  at  (10000,  10000,  6000) 
(m)  and  (20000,  20000,  5000)  (m).  The  interceptor  was  guided  by 
the  adaptive  S-4  guidance  law.  Fig.  7  shows  the  control  history, 
missile  velocity,  and  engagement  trajectory.  Estimations  of  Tg0, 
TgoA,  and  TgoB  are  displayed  in  Fig.  8.  The  resulting  trajectory 
shows  a  successful  target  engagement  with  the  proposed  guidance 
design. 

To  verify  robustness  of  the  engagement  performance,  we  have 
considered  the  setting  with  the  initial  target  position  at  (60000, 
60000,  30000)  (m),  midpoint  A  at  (10000,  10000,  6000)  (m),  and 
midpoint  B  at  (20000,  20000,  6000)  (m).  Fig.  9  shows  the  control 
history,  missile  velocity,  and  engagement  trajectory.  Although 
midpoint  B  was  intentionally  placed  at  an  unfavorable  position,  the 
guidance  law  can  still  steer  the  interceptor  to  an  interception  point. 


acceleration  (m/sec2)  &  Time-to-go  (sec)  acceleration  (m/sec^)  &  acceleration  (m/sec^) 
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Fig.  6.  (a)  Inertia  control  command,  (b)  missile  velocity,  (c)  engagement  trajectory. 


time  (sec)  time  (sec) 


Fig.  7.  (a)  Inertia  control  command,  (b)  missile  velocity,  (c)  engagement  trajectory. 


Fig.  8.  Estimation  of  time-to-go. 


Fig.  10(a)  plots  the  comparison  of  S-4  guidance  law  with  constant 
and  adaptive  gains.  Fig.  10(b)  illustrates  two  interceptor  flight 
trajectories  with  the  midpoint  A  set  to  be  (10000,  10000,  6000) 
(m)  and  (100000,  100000,  8000)  (m),  respectively.  Ultimately, 
the  performance  robustness  of  the  adaptive  S-4  guidance  law  to 
variations  of  the  midpoints  at  the  desired  flight  trajectory  is  thus 
verified. 

5.  Conclusion 

This  paper  proposes  an  adaptive  trajectory  shaping  guidance 
scheme  which  introduces  a  fuzzy  system  model  to  represent  gain 
scheduling  variables  and  realize  a  generalized  spline  guidance 
law.  The  spline  guidance  law  is  developed  with  the  aim  of 
shaping  the  interceptor’s  flight  trajectories  for  the  missile’s  energy 
conservation  and  performance  robustness.  It  is  shown  that  the 
proposed  guidance  law  yields  excellent  interception  performance 
against  a  variety  of  targets.  It  is  believed  that  the  generalized 
guidance  scheme  could  be  served  as  a  basis  for  the  development 


0  50  100  150  200  250  300  350  400 


time  (sec) 


0  50  100  150  200  250  300  350  400 

time  (sec) 


Fig.  9.  (a)  Inertia  control  command,  (b)  missile  velocity,  (c)  engagement  trajectory. 
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Fig.  10.  (a)  Comparison  of  S-4  guidance  law  with  constant  gains  and  adaptive  gains,  (b)  trajectories  generated  by  different  midpoints. 


of  a  wide  variety  of  mission  oriented  guidance  laws,  such  as  cruise 
missile  guidance,  anti-ballistic  missile  guidance,  etc. 
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